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Required Competences for Navigation 



Navigation is composed oUet^izationTTnapping and motion planning 
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The Planning Problem 



The problem: find a path in the work space (physical space) from an initial 
position to a goal position avoiding all collisions with obstacles 



■ Assumption: there exists a good enough map of the environment for 
navigation. 



■ Topological 

■ Metric 

■ Hybrid methods 
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The Planning Problem (cont.) 



1 We can generally distinguish between 

■ (global) path planning and 

■ (local) obstacle avoidance. 

1 First step: 

■ Transformation of the map into a representation useful for planning 

■ This step is planner-dependent 

1 Second step: 

■ Plan a path on the transformed map 



1 Third step: 

■ Send motion commands to controller 

■ This step is planner-dependent (e.g. Model based feed forward, path following) 
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Work Space (Map) - 


=>■ Configuration Space 



State or configuration q can be described with devalues q, 



v" 




Start 




Work Space 




Configuration Space: 

the dimension of this 

space is equal to the Degrees of Freedom (DoF) 

of the robot 
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Configuration Space for a Mobile Robot 



Mobile robots operating on a flat ground have 3 DoF: (x, y, 9) 

For simplification, in path planning mobile roboticists often assume that the 
robot is holonomic and that it is a point. In this way the configuration space 
is reduced to 2D (x,y) 



■ Because we have reduced each robot to a point, we have to inflate each 
obstacle by the size of the robot radius to compensate. 
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Outline 

Global Path Planning 
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Path Planning: Overview of Algorithms 



1 . Optimal Control 

■ Solves for the truly optimal solution 
» Becomes intractable for even moderately 
complex and/or nonconvex problems 
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2. Potential Field 

» Imposes a mathematical function over the 
stale/configuration space 

■ Many physical: metaphors exist 

■ Often employed due to its simplicity and 
similarity lo optimal control solutions 




3. Graph Search 

■ Identify a set of edges and connect Ihem to 
nodes within the free space 
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Optimal Control based Path Planning Strategies 



■ Overview 

■ Solves a two-point boundary problem in the continuum 



Limitations 

■ Becomes very hard to solve as problem dimensionality increases 

■ Prone to local optima 



Algorithms 

■ Pontryagin maximum principle 

■ Hamilton-Jacobi-Bellman 
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Potential Field Path Planning Strategies 
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■ Robot is treated as a point under the 
influence of an artificial potential field. 

■ Operates in the continuum 

■ Generated robot movement is similar to a 
ball rolling down the hill 

■ Goal generates attractive force 

■ Obstacle are repulsive forces 
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Graph Search 



1 Overview 

■ Solves a least cost problem between two states on a (directed) graph 

■ Graph structure is a discrete representation 



Limitations 

■ State space is discretized -> completeness is at stake 

■ Feasibility of paths is often not inherently encoded 



1 Algorithms 

■ (Preprocessing steps) 

■ Breath first 

■ Depth first 

■ Dijkstra 

» A* and variants 

■ D* and variants 
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Graph Construction (Preprocessing Step) 



Methods: 

► Visibility graph 

► Voronoi diagram 

► Cell decomposition 
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Graph Construction: Visibility Graph 




Particularly suitable for polygon-like obstacles 

Shortest path length 

Grow obstacles to avoid collisions 
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Graph Construction: Visibility Graph (cont.) 

■Pros 

■ The found path is oplimal because it is the shortest length path 

■ Implementation simple when obstacles are polygons 

■Cons 

■ The solution path found by the visibility graph tend to take the robot as close as 
possible to the obstacles: the common solution is to grow obstacles by more 
than robot's radius 

■ Number of edges and nodes increases with the number of polygons 

■ Thus it can be inefficient in densely populated environments 
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Graph Construction: Voronoi Diagram 




- In contrast to the Visibility Graph approach, the Voronoi Diagram tends to 
maximize the distance between robot and obstacles 

- Easily executable: Maximize the sensor readings 

- Works also for map-building: Move on the Voronoi edges: 1 D Mapping 
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Graph Construction: Voronoi Diagram (cont.) 



Pros 

■ Using range sensors like laser or sonar, a robot can navigate along the Voronoi 
diagram using simple control rules 

Cons 

■ Because the Voronoi diagram tends to keep the robot as far as possible from 
obstacles, any short range sensor will be in danger of failing 

Peculiarities 

■ when obstacles are polygons, the Voronoi map consists of straight and 
parabolic segments 
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Graph Construction: Cell Decomposition 




■ Divide space into simple, connected regions called cells 

■ Determine which open cells are adjacent and construct a connectivity 
graph 

■ Find cells in which the initial and goal configuration (state) fie and search 
for a path in the connectivity graph to join them. 

■ From the sequence of celts found with an appropriate search algorithm, 
compute a path within each cell 

■ e.g. passing through the midpoints of cell boundaries or by sequence 
of wall following movements. 
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Possible cell decompositions: 

■ Exact cell decomposition 

■ Approximate cell decomposition: 

■ Fixed cell decomposition 

■ Adaptive cell decomposition 
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Graph Construction: Cell Decomposition (cont.) 
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Graph Construction: Cell Decomposition (cont.) 
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Graph Construction: Cell Decomposition (cont.) 
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Graph Construction: State Lattice Design 
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Graph Search 



Methods 

■ Breath First 

■ Depth First 

■ Dijkstra 

■ A* and variants 

■ D* and variants 
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Discriminators 
- f(n) = g(n) + e h(n) 
■ 9<n') = g(n) + c(n,n') 
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Graph Search Strategies: Breadth-First Search 
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Graph Search Strategies: Breadth-First Search (cont.) 



Corresponds to a wavefront expansion on a 2D grid 
Use of a FIFO queue 

■ First-found solution is optimal if all edges have equal costs 

Dijkstra's search is an „g(n)-sorted" HEAP variation of breadth first search 

■ First-found solution is guaranteed to be optimal no matter the cell cost 
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Fig. 1: NF1: put in each cell its L L -distance 
from the goal position (used also in local 
path planning) 
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Graph Search Strategies: Depth-First Search 
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Use of a LI FO queue 

Memory efficient (fully explored subtrees can be deleted} 



L=go;il 



,3, gz ; 



CIS Faculty 
Department of Information Systems 



Mansoura University 



Graph Search Strategies: A* Search 




Similar to Dijkstra's algorithm, A* also uses a HEAP (but „f(n)-sorted") 
A* uses a heuristic function h(n) (often euclidean distance) 
' f(") = 9(n) + £ h(n) 
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Graph Search Strategies: D* Search 



1 Similar to A* search, except that the search begins from the goal outward 

1 f(n) = g(n) + e h(n) 

1 First pass is identical to A* 

1 Subsequent passes reuse information from previous searches 
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Graph Search Strategies: Randomized Search 



Most popular version is the rapidly exploring random tree (RRT) 

- Well suited for high-dimensional search spaces 

- Often produces highly suboptimal solutions 




45 iterations 
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